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Abstract 

pnj i#r ike. Stott of tht art in collision prevention for manipula- 

tors with revolute joints, showing that it is a particularly computationally hard 
problem } Based on the analogy with other hard or undecidable problems such as 
Keortm proving , t O^pmpsm^ an extensible multi- resolution architecture for path 
planning, based on a collection of weak methods^F inally, ws s aamitee the role 
that sensors can play for an on-line use of sensor data* 1 
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1. Introduction 

Automated collision prevention for robot manipulators is an 
essential feature seldom available, even in its simplest forms, 
in today’s robotic systems. The term “collision prevention" 
will refer to collision detection and collision-free path plan- 
ning. This paper presents current issues in collision preven- 
tion for manipulator robots with revolute joints in relation 
to the use of sensors. 

Given the difficulty of the problem, only partial solu- 
tions have been found. Furthermore, we believe that it is 
particularly constraining to have to assume that robotic sys- 
tems will operate in perfectly pre-m odeled environments, as 
do all the currently existing industrial systems. As a conse- 
quence of the “perfect model" approach, many largely un- 
solved issues immediately arise: uncertainty representation 
and assessment, time-varying environments, computational 
and storage complexity. 

We will rather advocate an “imperfect model" approach 
that will lead us to the consideration of a multi-level sys- 
tem heavily relying on sensory information and using multi- 
resolution algorithms. Instead of elaborating a theoretically 
exact method, and then deriving the computational and stor- 
age complexity in order to design a computer system to im- 
plement it, we will rather present methods that only par- 
tially solve the problem, but whose performance improve as 
the computing power is increased. Studying the problem of 
collision path-finding in connection with the available sens- 
ing techniques also provides some insight into the solution. 

2. Current Methodologies for path planning 

Experimental research in path-planning in the context of 
mobile robots has been fo far more successful because of the 
reduced complexity of the two-dimensional case. However, 
many concepts developed in the two-dimensional case do not 
extend readily to the three-dimensional case. For example, 
the conceptually attractive “configuration space approach" 
fails to extend easily to the case of manipulators with rev- 


olute joints, whereas it applies very nicely to the case of 
mobile robots. The reason is that the Cartesian space, in 
which obstacles — or free-space — are described, maps very 
awkwardly into the configuration space. In case of a manipu- 
lator, the configuration space is equivalent to the joint space. 
The mapping is highly non-linear and occurs between spaces 
of different dimensionalities. The computational complexity 
becomes unmanageable beyond three joints for the problem 
of mapping the Cartesian space scene into joint space as well 
as for searching the resulting graph. The approach is limited 
to three joints (Lozano 1986, Gouzene 1984) even if recursive 
decomposition schemes are utilized (Faverjon 1985). 

Another widely adopted approach (Khatib 1986) is of lo- 
cal nature and consists of the computation of a artificial field 
of potential increasing near obstacles, and globally decreas- 
ing toward a goal position. Pseudo-forces are then included 
in the low-level motion servo computations of the manipu- 
lator. As a result, the manipulator is controlled to move 
away from obstacles and toward the goal position. Unfortu- 
nately, the method breaks down in obstacle configurations 
that create local minima. Computational complexity also 
precludes attempts to enlarge the scope of this method. The 
great attraction of this idea is the possibility to use sensor 
data directly for the computation of the potential instead 
of an a priori model. Similar schemes can be formulated 
in kinematic terms, that is in terms of velocities, instead of 
forces. The problem of local minima can be largely elimi- 
nated by the use of redundant manipulators: the trajectory 
of the end-effector can be complete!) specified and the re- 
dundant linkage?* used to avoid obstacles u?*ing onl> local 
information (Maciejcwski 1985). Operation Research has 
been also considered helpful to attack the complexity prob- 
lem (Grechanovsky 1983). 

The methods of the last categor) resort to limit the 
class of tasks being planed. For example, the range of mo- 
tions can be restricted to pick and place operations (Brooks 
19836). Similarly. the range of obstacles can be restricted, 
for example to pillars shapes {Luh 1984). 
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3. Proposed Ideas 

We would like to suggest a few new ideas to the problem 
of collision prevention, in the view of their use in an on- 
line control system. We mean by that, trajectory generation 
techniques that allow the computation of collision-free tra- 
jectories in the same amount of time as require by the mo- 
tion of general purpose robots, using limited computational 
resources. At this point, we would like to draw an analogy 
with the problem of theorem proving in computational logic. 
This problem is undecidable, that is to say, if the proposition 
submitted to the system is in fact false, the result cannot be 
obtained in a finite number of steps. 

The search space to explore in order to prove a propo- 
sition can become arbitrarily large. If the proposition under 
study in indeed provable, efficient methods in theorem prov- 
ing attempt to use powerful heuristics to reduce the search 
space. These heuristic methods are called “weak methods” 
because they do not guarantee success, but are likely to con- 
verge in most interesting cases. If the proposition is false, 
this conclusion may not be reachable in a finite number of 
steps, and one has to resort to cut the search at some arbi- 
trary point and to assume that the proposition probably is 
false. 

In path planning, there are many heuristics available, 
and we suppose a limited amount of available computations, 
hence the architecture described below, based on a collection 
of weak methods. 

3.1. Computational Architecture 

We require the system to be extensible in the sense defined 
by Brooks (Brooks 1986). As researchers are devising new 
methods to calculate collision free trajectories, we would like 
to be able to integrate these advances while causing a min- 
imum of disturbances to existing and working parts of the 
system. 

The following diagram illustrates the design concept of 
an extensible architecture. The question of whether each of 
the methods will reside on one or several processors is of lit- 
tle importance. What is is important is to design them as 
peers such as they can accept the same input and produce 
the same output formats. The crucial point is not to attempt 
to parallelize the computations of one particular method, be- 
cause we know that many of them require exponential times 
to execute, but to parallelize the methods between them so 
that we obtain a natural selection of the most appropriate 
for the situation at hand. 


The computations should be done at a least two levels. The 
top-level searches for collision-free trajectories, using any of 
the methods available. Input to the high-level is data ob- 
tained from global sensor measurements as discussed in the 
section “Sensors,” or from pre-determ ined models obtained 
from data-bases. The lowest level is a local collision detector 
that also uses either sensor information or pre-determ ined 
model information. We will require an efficient collision 
detector to certify the proposed trajectories, or use on-line 
proximity sensor mounted on the arm to locally modify the 
trajectories as they are executed. In the later case, we take 
the chance that the motion may never terminate. 

3.2 A Variety of Heuristics: Archetypical Motions 

The study of robot motions shows that given an approxi- 
mate description of a robot's environment, and given the ini- 
tial and final configurations, robot motions can be classified 
into classes of archetypical motions. A preliminary analysis 
shows that collision-free motions bear a strong relationship 
with the structure of the workspace. This relationships can 
be exploited to built a system that infers plausible motions. 
In this framework, the problems under study are: 

- Classification of obstacles according to the influence 
that their shape might have on the motions: small, 
large (with respect to the robot), compact, elongated, 
fiat, etc... Interesting simple cases are: spheres, infinite 
cylinders, half spaces, and holes. 

- Classification of the relations between these obstacles 
with respect to the robot elements: proximity, position 
with respect to the elbow, under, above, on the left, on 
the right, etc... Inference will occur on criteria of this 
kind. 

- Classification of typical motions: retraction, extension, 
sweep, wrist re-orientation. The consequences of these 
motions are explicit: if joint No 1 turns in the positive 
direction and the arm is stretched, then end-effector 
sweeps on the left; if the arm retracts and is in the elbow 
up configuration, then the end-effector moves inward, 
and the elbow moves upward, etc... 

Once the scene and the robot attitude are encoded in 
terms of facts and rules, motions can be generated by auto- 
matic inference. 
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3.3 Joist Decoupling 

Joint decoupling is another way to attack the problem. The 
observation of certain collision avoiding motions reveals that 
motion planning can be performed by planning the motions 
of the joints independently. During such a motion, in the 
reference frame attached to esch link of a robot, all the ob- 
stacles appear as moving obstacles. The task consists for 
each link to plan a one-dimensional trajectory in its own co- 
ordinate frame with a time-varying environment. We know 
from (Kant 1984 and 1986) that such a planning is possible, 
by planning the velocity along a predetermined path. This 
algorithm finds solutions in a large number of cases, when 
the priority among the set of joints is adequately determined. 
The problem is formaly equivalent to moving multiple ob- 
jects as in (Erdman 1986). 

3.4 Piece-Wise Trajectory Decomposition 
Another heuristic method can be described as follows. If 
the arm is to move from point A to point B, a trajectory is 
generated at the first iteration using a very simple scheme: 
a linear joint interpolated motion between A and 0, for ex- 
ample. The trajectory is then verified. In case of collision, 
an in ter mediate knot point is generated by the closest non 
interfering position. The initial segment is then split and 
the process recursively iterated on the sub-segments. 

3.5 The generate- test- refine architecture 

We have just listed three powerful heuristics to reduce the 
search space of the problem. There exist others. We can 
augment the power of these heuristics by feeding back to a 
motion planner information provided by the collision detec- 
tor in case of the failure of a plan, or information provided 
by a merit estimator, in case of success. The system is left 
interating during the allocated time period, the last best 
solution being retained. 

3.5 Good Collision Detectors 

Of what precedes, we require a good quality collision de- 
tector, that is to say, one that does not require exponential 
nor polynomial times to perform and one that uses multi- 
resolution algorithms. This problem has been examined in 
(Hayward 1986), One approach is to perform the modeling 
the robot in terms of contro* points scattered on its bound- 
ary. Collision detection can be then performed by showing 
that all the control points are in free-space. (note that there 
is no need to worry about rotations). A multi-resolution 
system can then be easily obtained. 

The quality of the result augments with the allocated 
running time and the CPU power. Methods for generating 
multi-resolution control points are indicated in (Bhan 1986), 
Octree encoding methods provide very naturally for multi- 
resolution algorithms, however, we have other schemes under 
consideration because octree make no use of the coherence 
that might be present in a scene and therefore can lead to 
great inefficiencies. 


4 . Sensors 

“Model Building Sensing" is used to gather global three- 
dimensional information from the environment. In a robotic 
context, the sensors perform a “surveying” function, provid- 
ing information to be used by the path planning module. 
This is quite different from the on-line uses of sensors in 
which the local environment is continuously sampled so as 
to avoid crashes. In particular, model building sensors must 
operate over a wider range than their servoing counterparts. 

4.1 Global Sensors versus Proximity Sensors 

The chosen sensor must be either a proximity sensor at- 
tached to a “roving” arm or it must be capable of acquir- 
ing three-dimensional information at a distance. In the first 
case, the accuracy is limited only by that of the manipula- 
tor. However, control problems are likely to crop up for com- 
plex environments where concavities abound. Such problems 
arise because the environment is not known a priori: in fact, 
the environment is difficult to explore precisely because it is 
not known! Consequently, such a process is likely to be a 
slow one. 

We contend that such proximity methods are only ad- 
visable when the task environment is so intricate that spatial 
considerations prevent larger apparatus such as those we de- 
scribe below to conveniently operate. Suppose for example 
that we wish to model the bottom of a narrow, oblong cav- 
ity inside a given object. We can safely assume that our 
robot arm can indeed penetrate the cavity and orient itself 
within it, since otherwise there would be little point in mod- 
eling it. Using the very manipulator which is to perform the 
robotic task is then the most direct way to model the task 
environment. 

4.2 Acquiring 3-D Information 

Techniques developed for acquiring three-dimensional infor- 
mation at a distance are still the preferred answer to auto- 
mated model-building in most cases. These techniques can 
be either photometric or telemetric. 

4.2.1 Photometric Techniques 

Photometric techniques attempt to infer distance from pho- 
tographic images. Bui such images map intensity, an extrin- 
sic characteristic of the three-dimensional world, onto the the 
two-dimensional plane along the lines of a perspective pro- 
jection. The task of recovering the correct interpretation for 
a given image is then a formidable one since it requires that 
the perspective ambiguity (lines map into points) be resolved 
from the intensity cue alone; formally, this task consists of 
inverting an illumination-reflectance operator / which maps 
the three-dimensional scene to the image plane. The so- 
called “shape-from” techniques attempt to perform that dif- 
ficult inversion using a combination of analytical work (Horn 
1968; Horn 1975: Ferrie 1986; Levine, O’Handley and Yagi 
1973), and of higher-level cognitive processes (Rosenburg, 
Levine and Zucker 1978; Bajcsy and Lieberrnan 1976: Shirai 
1973: Nlarr 1976|. -These methods have been much investi- 
gated in part for their similarity to human visual processing, 
but also because they do not require sophisticated optical 
hardware. 
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4.2,2 Telemetric ‘Technique* 

In contrast with photometric techniques, telemetric tech- 
niques usually require specialized hardware but are much 
easier to analyze in return and therefore constitute a much 
preferable means for automatic three-dimensional scene ac- 
quisition. The goal here is to build “range images": a range 
image maps the distance of the closest point in the scene to 
every node of an orthographic grid the size of that scene. 
These images are usually constructed by monitoring pat- 
terns of points (Hasegawa 1982; Ishii and Nagata 1976), lines 
(Oshima and Shirai 1979: Sato and Inokuchi 1985), or grids 
(Potmesil 1979) of light which are successively projected onto 
the scene and reflected to a sensor located at or near the light 
emitting device (often a laser). Either positional analysis of 
the returning rays or time-of- flight discrimination can now 
be used to infer the range of the closest obstacle. In the first 
case, simple geometrical relationships relating emitted and 
returned rays yield the sought distance in a process called fri- 
angulation. In the second case, the time taken by light rays 
to travel from and back to the emitting laser source allows 
us to calculate that same distance. Needless to say, the prac- 
ticability of the latter method is limited by the very sophis- 
ticated electronics that the enormous speed at which light 
travels requires (Lewis and Johnston 1977; Nitzan, Brain 
and Duda 1977.) 

An alternative time-of-flight method uses sound waves 
instead of light rays because of their more manageable speed. 
Although simple in principle, the method suffers from vari- 
ous engineering problems such as the need for frequent recal- 
ibration. the difficulty experienced in focusing sound waves, 
as well as their hard-io-model reflective properties. 

In summary, the “safest" and most accurate methods 
of acquiring distance information seems at present to be 
triangulation. However, one should not discount ultrasonic 
time-of-flight methods which are already commercially avail- 
able. Further, many researchers believe that laser time-of- 
flight methods will soon present itself as the most viable 
method since it offers in theory the greatest absolute ac- 
curacy. The interested reader should refer to the excellent 
review by Jams {Jarvis 1983) for further reading on range 
acquisition techniques. 

5. Conclusion 

In this paper, we have presented an overview of methods re- 
lated to the collision prevention for manipulators with rev- 
olute joints. It has been shown that it is a difficult problem 
in its generality and we have proposed a computational ar- 
chitecture based on an analogy with an another domain of 
Artificial Intelligence. 
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